Electronics/Computers 


Indoor Navigation Using Direction Sensor and Beacons 

Position and orientation are determined from directions to at least three beacons. 
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A system for indoor navigation of a mo- 
bile robot includes (1) modulated in- 
frared beacons at known positions on the 
walls and ceiling of a room and (2) a cam- 
eralike sensor, comprising a wide-angle 
lens with a position-sensitive photodetec- 
tor at the focal plane, mounted in a known 
position and orientation on the robot. 
The system also includes a computer run- 
ning special-purpose software that 
processes the sensor readings to obtain 
the position and orientation of the robot 
in all six degrees of freedom in a coordi- 
nate system embedded in the room. 

For a given beacon imaged on the 
focal plane, the output of the sensor 
comprises two parameters that depend 
in a known way on the characteristics of 
the lens and the direction to the beacon 
in a coordinate system attached to the 
sensor and robot. If at least three bea- 
cons are within the field of view of the 
sensor, then the sensor outputs from ob- 
servations of all three beacons can be 
combined to obtain six parameters in- 
dicative of the directions to all three 
beacons. These directions, in combina- 


tion with the known positions of the bea- 
cons, uniquely determine the position 
and orientation of the robot in the 
room. Equivalently, the six parameters 
constitute, in principle, sufficient data to 
locate the robot in all six degrees of free- 
dom by solving the equations that ex- 
press the applicable geometric relation- 
ships summarized above. 

The nature of a position-sensitive 
photodetector is such that it is not pos- 
sible to measure the centroids of two 
beacon images simultaneously. There- 
fore, it is necessary to provide for illu- 
mination of the beacons in rapid suc- 
cession and to provide means for the 
image-data-processing software to rec- 
ognize which beacon is under observa- 
tion at a given instant. To satisfy this 
need, the beacons are turned on and 
off in a sequence that coincides with a 
predetermined code. The sensor sub- 
system accumulates beacon readings 
and their times until it begins to recog- 
nize the code sequence. Thereafter, the 
computer processes the readings from 
the recognized beacons within the field 


of view of the sensor. 

The equations for the geometric rela- 
tionships are nonlinear. The software 
includes a module that solves these equa- 
tions by means of an iterative optimiza- 
tion procedure, in which it strives to find 
a position and orientation that, when in- 
serted in the equations, minimizes a mea- 
sure of the difference between the actual 
sensor readings and the sensor readings 
predicted by the equations. 

Another software module provides an 
initial guess of position and orientation 
to start the optimization procedure. 
Knowing which beacons are in view, this 
module applies to the equations for a 
number of postulated robot poses and 
determines which pose, when inserted 
in the equations yields the closest match 
to the sensor readings. The closest 
match becomes the initial guess for the 
optimization procedure. 

This work was done by Joel Shields and 
Muthu Jeganathan of Caltech for NASA’s Jet 
Propulsion Laboratory. Further informa- 
tion is contained in a TSP (seepage 1 ). 
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